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1.0  INTRODUCTION 


Feedforward  compensation  has  been  applied  to  specific  control  system  tasks  for  some 
time.  For  target-tracking  applications,  feedforward  will  typically  appear  together  with 
some  appropriate  combination  of  output  error  feedback  compensation  (including  integral 
control)  and  plant  inner  loop  (e.g.  rate)  feedback  in  the  overall  control  scheme  (see  Fig. 
1).  One  advantage  of  feedforward  control  is  to  quicken  the  plant  tracking  response  by 
providing  the  controller  with  “early  information*  about  the  future  target  trajectory,  thus 
reducing  the  transient  portion  of  the  tracking  error.  Another  effect  of  feedforward  can  be 
realized  in  situations  when  an  oscillating  target  is  to  be  tracked  and  where  the  variabil- 
ity/uncertainty  (v/u)  associated  with  the  target  dynamic  parameters  (e.g.  frequency  of 
target  oscillitory  motion)  is  significant.  For  these  cases,  it  is  straightforward  to  show  that 
integral  control  does  not  ensure  zero  steady-  state  error  over  the  entire  target  parameter 
v/u  range  so  that  the  feedforward  controller  parameter  choices  will  have  a  significant 
impact  on  the  steady-state  errors  in  addition  to  the  transient  errors. 

A  drawback  of  feedforward  control  is  that  direct  measurements  of  one  or  more  target 
motion  states  must  be  obtained  using  additional  sensors  and  noise  filters,  resulting  in 
a  more  costly  and  complex  control  system  to  implement.  The  question  is  thus  raised 
whether  a  single  set  of  feedforward  controller  parameters  can  be  determined  that  offers 
enough  average  performance  improvement  over  the  plant  and  target  parameter  v/u  ranges 
to  justify  “costs”.  That  is,  can  a  feedback-only  control  scheme  using  error  and  plant  rate 
measurements  only  be  designed  that  affords  nearly  as  good  performance  for  lower  cost 
and  simpler  implementation? 

In  this  report,  a  target-tracking  design  problem  is  developed  for  a  two-link, two- 
actuator  mechanical  arm  to  explore  conditions  under  which  feedforward  can  be  expected 
to  provide  significant  improvements  over  a  simple  feedback-only  control  scheme  in  both 
transient  and  steady-state  tracking  performance. 


Plant  State 


2.0  PROBLEM  LAYOUT  AND  DESIGN  APPROACH 


The  Stanford  University  Aero/ Astro  Robotics  Laboratory  two- link,  two  actuator 
(2L/2A)  mechanical  arm  is  nearing  completion  of  construction. 

One  of  the  future  tasks  envisioned  for  this  arm  is  to  demonstrate  ability  to  operate 
effectively  in  a  target-tracking  mode  despite  variability /uncertainty  (v/u)  in  the  arm  and 
target  dynamic  parameters.  Figure  2  is  a  schematic  of  a  possible  future  target-tracking 
application  for  the  2L/2A  arm.  Here  it  is  desired  for  the  arm  tip  to  track  motions  in  the 
horizontal  plane  of  an  object  suspended  by  a  cable  from  an  overhead  conveyor  belt  moving 
at  constant  velocity  vRg .  The  object  is  assumed  to  have  recently  passed  through  a  paint- 
spray  booth  and,  upon  exit,  continues  to  undergo  natural,  undamped  oscillatory  motion 
superimposed  upon  the  rectilinear  belt  motion  yR(t)  at  constant  velocity  vRg.  Assuming 
a  small  nominal  angle  90  between  the  attachment  cable  of  length  l  and  the  vertical 
reference,  it  can  be  shown  [1]  that,  under  ideal  conditions,  the  linearized  horizontal  plane 
trajectory  for  the  target  object  is  approximated  by  a  slowly  processing  ellipse.  The  target 
completes  one  traversal  of  the  ellipse  every  r  seconds,  where 


The  processional  frequency  of  the  major  axis  of  the  ellipse  is  given  by: 


ljt 

T  P 


In  this  work,  it  is  assumed  that  0O  is  small  enough  to  neglect  the  processional  motion 
component.  However,  randomness  associated  with  the  ellipse  amplitude,  eccentricity,  and 
orientation  is  accounted  for  as  discussed  in  Section  3.1. 


At  time  t  =  0+,  the  target-tracking  control  sequence  is  initiated.  The  goal  is  to  cause 
the  arm  tip  to  track  the  target  object  to  within  a  tolerance  of  ±  1  cm  for  all  times  greater 
than  t,  =  10  seconds.  In  meeting  (or  exceeding)  these  error  requirements,  the  torque 


motor  peak  (r ms  continuous)  limits  of  ±  15  N-m  (db  3  N-m)  are  not  to  be  violated. 

At  any  time  between  t,  and  tj  =  20  secs  (corresponding  to  the  point  yR(t /)  at 
which  point  the  conveyor  belt  “ends”),  a  gripping  mechanism  of  mass  Mtip  attached 
to  the  arm  tip  will  thus  be  in  reasonably  good  position  to  “reach  up”  and  grasp  the 
target  object  with  low  relative  impact  velocity  and  subsequently  transfer  the  object  to 
some  other  designated  point  in  the  assembly  area.  This  control  sequence  {t0,t/)  is  to  be 
continuously  repeated  throughout  the  daily  operational  hours  of  the  assembly  line. 

Variable  dynamic  parameters  associated  with  this  problem  are: 

(1)  arm  gripper  mass  (Af<,>) 

(2)  target  frequency  of  oscillation  (wr) 

The  variations  in  Mtip  and  uiT  are  taken  to  be  discrete  (e.g.  due  to  sudden  changes 
in  gripper  size  and/or  cable  length  by  the  plant  operator  to  accomodate  target  objects  of 
differing  dimensions).  However,  it  is  assumed  that  all  discrete  changes  in  these  parameters 
occur  between  tracking  control  sequences  so  that  Mttp  and  wr  are  constant  (although 
possibly  unknown)  during  any  single  sequence  (t0,t/). 

The  designer’s  task  is  to  devise  an  effective  target- tracking  control  strategy  which  is 
in  some  sense  “robust”  to  the  v/u  dynamic  parameters.  One  approach  to  the  problem 
would  certainly  be  to  consider  the  use  of  some  type  of  adaptive  control,  such  as  gain 
scheduling  in  tandem  with  a  parameter  identification  scheme  for  determining  M,ip  and 
uT.  An  alternative  (and  probably  simpler  to  implement)  approach  is  to  design  control 
logic  using  a  single  set  of  constant  controller  parameter  values  which,  on  the  average, 
provides  good  tracking  performance  over  the  target  and  plant  parameter  v/u  ranges. 
The  latter  approach  is  the  one  taken  in  this  work. 


20  secs  t  =  10  secs 


FIG.  2  TARGET  TRACKING  APPLICATION  FOP.  2L/2A  ARM:  PICK  UP  FROM  PAINT  SPRAY  BOOTH 
Robot  arm  tip  to  rendezvous  and  grasp  swinging  object  (target)  after 
t  =  t+  +  10  secs  but  before  t_  =  t+  +  20  secs 


2.1  Choice  of  Controller  Structures 


The  capacity  of  any  controller  design  for  providing  good  target-tracking  performance 
will  depend  to  a  large  extent  on  the  structure  of  the  controller  (i.e.  specification  of 
sensors;  order  and  form  of  compensation)  in  addition  to  the  numerical  values  specified 
for  the  unconstrained  parameters  (e.g.  gains)  of  the  structure. 

Three  separate  controller  structures  are  designed  and  evaluated  for  their  effectiveness 
in  providing  good  average  transient  and  steady-state  tracking  performance  over  large  v/u 
ranges  for  Mup  and  u>T: 

(I)  NoFF:  A  controller  featuring  Proportional-Integral*  output  error  feedback 

plus  feedback  of  arm  angle  rates  and  no  feedforward  (Fig.  3). 

(II)  FSFF:  Same  as  (I)  plus  full-target-state  feedforward  (Fig.  4)  or  the  near 

equivalent  using  noise-free  measurements  of  position  coordinates 
together  with  an  approximate  differentiation  network  to  obtain 
rate  coordinates  (Fig.  5) 

(III)  ESFF:  Same  as  (I)  plus  feedforward  of  estimated  target  states  given: 

(a)  noisy  measurement  of  position 
coordinates(FFl) 

(Fig.  6) 

(b)  noisy  measurements  of  position 
and  rate  coordinates  (FF2) 


Note  that  “Integral*”,  as  used  here,  refers  to  a  generalization  of  the  classical  “1/s” 
integrator  to  a  form  better  suited  for  tracking  target  motion  consisting  of  a  superposition 
of  a  ramp  plus  oscillatory  motion  at  frequency  <jt  (i.e.  “1/s2”  plus  “l/(s2  +o/2)”). 

From  Fig.  3,  it  is  seen  that  the  1,  portion  of  the  Integral*  block  has  a  Laplace  domain 
representation: 

jj,.w  = 

'  S*  +  fljS  +  02 

For  the  case  where  ai  =  0,  it  can  be  shown  analytically  that  inclusion  of  this  specific  form 
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(sometimes  referred  to  [3]  as  “rotating”  or  sinusoidal  integral  control)  will  guarantee  zero 
steady-state  tracking  error  with  respect  to  target  oscillatory  motion  at  frequency  s/a^.  In 
addition,  the  rotating  integral  control  provides  robustness  in  the  sense  that  it  preserves 
the  zero  steady-state  error  property  for  any  values  of  the  arm  or  controller  parameters 
(assuming  the  arm  dynamics  remain  stable).  If  the  target  frequency  uT  =  uJTnom  were 
invariant  and  well-known,  then  we  could  indeed  set  at  =0,  a2  =  u/Tnom  and  be  assured 
of  perfect  steady-state  tracking.  However,  wT  is  one  of  the  variable  parameters  in  this 
design  problem.  Hence,  we  allow  both  at  and  a2  to  be  free  parameters  to  be  decided 
upon  by  an  optimization  process  (see  Section  2.3)  which  will  account  directly  for  the 
variability  in  ljt. 

Similarly,  it  is  readily  apparent  from  Fig.  3  that  the  Laplace  representation  of  the  It 
sub-block  is  simply: 

r„,  (.)  -  (•) 

Inclusion  of  this  integrator  term  in  conjunction  with  the  natural  1/s  integration  from  arm 
tip  velocity  to  position  will  guarantee  zero  steady-state  error  with  respect  to  the  ramp 
portion  of  the  target  motion. 

For  the  FSFF  structure,  the  point  is  made  that,  given  a  relatively  noise-free  measure¬ 
ment  of  a  target  position  coordinate  yT  only,  an  estimate  of  the  corresponding  target 
rate  coordinate  vT  can  be  obtained  by  implementation  of  an  approximate  differentiator 
with  s-domain  form: 

*<•>  “  IT jW 

The  above  representation  corresponds  in  the  time  domain  to  a  “reduced-order  ob¬ 
server”  of  target  rate  given  a  measurement  of  position.  Since  the  target  position  mea¬ 
surement  is  assumed  to  be  relatively  noise-free,  the  gain  L  can  be  made  very  large  in 
which  case  the  estimate  vr  is  a  very  good  approximation  to  actual  vT.  In  this  case, 
the  performance  of  the  controller  of  Fig.  5  will  be  almost  identical  to  that  of  the  ideal 
FSFF  controller  of  Fig.  4.  Of  course,  if  high  L  is  to  be  used,  it  is  essential  that  the 
differentiation  network  (i.e.  observer)  be  allowed  to  run  open  loop  for  a  short  time  prior 
to  t  =  <o  to  provide  for  decay  of  large  initial  transients  in  0r  before  any  control  action 
is  taken. 


It  is  noted  that  the  performance  obtained  using  FSFF  represents  the  ideal  perfor¬ 
mance  attainable  using  either  FF1  or  FF2  in  the  absence  of  noise. 

At  the  cost  of  providing  extra  sensors,  the  addition  of  feedforward  compensation  to 
the  baseline  NoFF  structure  would  appear  to  offer  a  means  for  improving  the  performance 
without  affecting  the  arm  stability  characteristics.  In  this  report,  no  attempt  is  made  to 
provide  a  rigorous  mathematical  demonstration  of  the  mechanism  by  which  feedforward 
compensation  can  beneficially  affect  the  tracking  performance  (analysis  of  either  transfer 
function  Y (s)/Fr(s)  or  B(s)/Yt(s)  can  provide  a  great  deal  of  insight  into  this  question 
...Ref.  [2]  and  [4]).  Instead,  using  recently  developed  techniques  for  quadratic  synthesis 
of  robust  controllers  for  “optimal”  target-tracking,  the  feedforward/feedback  structures 
are  designed  and  evaluated  against  the  NoFF  structure  designed  to  the  same  criteria. 
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target  position  and  rate  coordinates. 


2.2  Choice  of  Performance  Criteria 

In  order  to  determine  the  relative  advantages  of  including  feedforward  of  measured 
(and/or  estimated)  target  states  in  the  overall  target-tracking  control  scheme,  it  is  essen¬ 
tial  that  each  of  the  proposed  controller  structures  be  designed  and  evaluated  according 
to  some  consistent  performance  criterion  which  adequately  reflects  the  design  goals  stated 
previously.  For  example,  this  criterion  might  be  stated  in  physical  terms  as: 

PERFORMANCE  CRITERION  A:  “Minimum  average  (over  parameter  v/u  ranges) 
value  achievable  for  a  weighted  sum  of  mean  square  transient  and  steady-state  tracking 
errors  without  exceeding  allowable  limits  on  peak  and  steady-state  torques” 

This  criterion  is  useful  in  the  typical  case  where  a  specific  torque  motor  is  available 
and  it  is  desired  to  produce  the  lowest  errors  possible  without  violating  the  torquer 
allowable  limits.  Alternatively,  the  primary  task  of  the  preliminary  design  phase  may  be 
to  size  the  torque  motor  for  given  bounds  on  the  tracking  errors,  in  which  case: 

PERFORMANCE  CRITERION  B:  “Minimum  average  value  of  a  weighted  sum  of 
peak  torque  and  steady-state  torques  required  to  insure  that  mean  square  transient  and 
steady-state  tracking  errors  do  not  exceed  some  specified  bounds” 

An  effective  synthesis  tool  for  optimizing  controller  parameters  according  to  P.C. 
(A)  or  P.C.  (B)  is  provided  by  a  modified  version  of  a  recently  developed  computer 
algorithm  (“SANDY”)  for  the  design  of  robust,  low-order  controllers  ([4]  and  [5]).  The 
modified  algorithm  (“SANDYl”)  uses  a  non-linear  programming  search  to  minimize  a 
newly  defined  quadratic  performance  index  especially  suited  to  the  important  class  of 
target-tracking  problems  for  which  the  target  dynamics  are  characterized  by  one  or  more 
neutrally  stable  and/or  unstable  modes.  A  brief  description  of  this  algorithm  is  described 
next. 
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2.3  Brief  Description  of  “SANDYl”  Design  Algorithm 


Given  linearized  plant  and  target  dynamics  corresponding  to  parameter  condition  i 
of  the  form: 
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where  w'  and  w‘r  are  zero-mean  white  noise  sources  with  power  spectral  densities  given 
by: 


w(t)w’(r) 

w(t)wr'r)  ' 
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Random  initial  conditions  are  described  by  the  covariance  matrix: 

Xi'  =  E  [*wf 

The  target  dynamics  matrix  FT  may  be  characterized  by  one  or  more  neutrally  stable 
and/or  unstable  modes.  However,  it  is  assumed  that  these  modes  are  “excited”  only  by 
random  initial  conditions. 


Given  a  constant  parameter  compensator  structure  of  the  form: 


y\  =  H\x"  +  D\u  u'  4-  D*,w  w* 
u*  =  Dy  1  +  Cz' 
z{  =  Azi  +  By  I 


if  = 


The  SANDYl  algorithm  for  design  of  robust  target-tracking  controllers  is  based  upon 
minimization  with  respect  to  the  unconstrained  elements  in  K  of  a  “weighted-average” 
quadratic  performance  index  of  the  following  form  (simplified  form  for  illustrative  pur¬ 
poses): 


(i)  J'  =  LZlpiJ' 


(II)  J‘  =  E  I  lim 

v  ’  1  */— oo 


2  tf 


d"  2 


'/  \ 
+  1J  Ae''<?Ae’  +  At/  flAu'  dt  I 


where, 


np  =  total  number  of  discrete  plant/target  parameter  conditions 

/?’  =  probability  for  occurrence  of  plant/target  parameter  condition  i 

e'(t)  =  tracking  error  vector  of  dimension  no  =  e'„(<)  +  Ae'(f)  =  H'tx't  —  H'x' 
(see  Fig.  7) 


«'(0 

C(t) 

MO 

Au'(t) 


control  vector  of  dimension  nc  =  u^,(f)  +  Au'(t)  (see  Fig.  7) 

steady-state  portion  of  tracking  error  vector 

steady-state  portion  of  control  vector 

transient  portion  of  tracking  error  vector 

transient  portion  of  control  vector 

initial  value  of  control  vector 

finite  time  interval  over  which  transient  criteria  are  to  be  “penalized” 
...selected  by  designer 


A  more  compact  form  of  J‘  is  obtained  by  use  of  the  following  definitions: 
—  (no  *  no)  time-averaged  covariance  matrix 


associated  with  the  steady-state  error  vector  =  E 


(nc  *  nc)  time-averaged  covariance  matrix 


associated  with  the  steady  state  control  vector  =  E 


lim  - 

1  l;-0O  tf 


(no  *  no)  time-averaged  covariance  matrix 


associated  with  the  transient  error  vector  =  E 


j  Ae'Ae'’ 
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[Au^,]  =  (nc  *  nc)  time-averaged  covariance  matrix 

associated  with  the  transient  control  vector 

(nc  *  nc)  covariance  matrix  associated  with  the  initial  control  vector 
— -  E  (uo  u</) 

arbitrary-valued  dimensionalizing  parameter  selected  by  designer  (e.g.  set 
equal  to  desired  error  settling  time) 

arbitrary-valued  dimensionalizing  parameter  selected  by  designer  (e.g.  set 
equal  to  desired  control  settling  time) 

Employing  the  matrix  trace  operator  together  with  the  above  definitions,  we  can  express 
(I)  and  (II)  as: 

(in)  r  = 

(iv)  r  =  i  +  <?[Ad]‘  +  R.  [<.]' 

+  r..  +  r  [A«i]') 

The  cost  function  and  its  gradients  with  respect  to  the  unconstrained  compensator 
parameters  have  been  evaluated  analytically  ([4]  and  [5])  to  speed  convergence  of  the 
non-linear  programming  search  for  a  local  minimum  of  J‘. 

The  designer  chooses  the  order  and  form  of  the  compensator  structure  and  makes 
an  initial  guess  (not  necessarily  resulting  in  a  stable  plant  for  all  i)  for  the  compensator 
parameters.  The  iterative,  non-linear  programming  search  then  ensues.  The  finite  time 
formulation  of  the  transient  portion  of  the  cost  function  was  proposed  [5]  primarily  as 


a  means  for  avoiding  computational  difficulties  associated  with  an  unstable  initial  guess 
for  the  compensator  parameters. 

The  above  form  for  the  cost  function  is  particularly  well  suited  to  tracking  problems  in 
which  the  linearized  target  dynamics  contain  neutrally  stable/unstable  modes.  For  these 
problems,  steady-state  tracking  errors  and  control  responses  may  occur  depending  upon 
factors  such  as  choice  of  controller  structure  and  variability  of  plant/target  parameters. 
Note  that  a  seperate  weighting  on  initial  total  control  effort  is  also  allowed.  It  has  been 
found  [4]  that  inclusion  of  this  term  provides  a  more  direct  means  of  meeting  design  specs 
for  peak  allowable  transient  control  excursion.  In  general,  the  above  formulation  of  J* 
gives  the  designer  more  flexibility  to  trade  off  transient  versus  steady-state  performance 
criteria  so  as  to  meet  the  specific  target-  tracking  design  requirements. 
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3.0  SINGLE-LINK,  SINGLE-ACTUATOR  MODEL 


To  facilitate  understanding  of  the  important  trade-offs  involved  in  the  design  of  robust 
target-tracking  control  logic  for  the  2L/2A  arm,  a  simplified  single-link,  single-actuator 
(1L/1A)  model  of  the  problem  is  first  considered.  In  this  case,  we  consider  the  arm  joint 
to  be  locked  with  anom  =  pnom  =  0°  and  Torque  Motor  B  inoperative  (see  Fig.  2).  It 
is  desired  to  find  a  control  law  T,^(t)  which  causes  the  arm  (with  variable  mass  M,ip 
assumed  concentrated  in  the  tip)  to  track  effectively  rectilinear  target  motion  consist¬ 
ing  of  an  oscillatory  component  at  (variable)  frequency  uiT  superimposed  on  the  cable 
attachment  point  motion  at  constant  velocity  uTo. 

For  the  1L/1A  version  of  the  problem,  we  shall  consider  the  effects  of  carrying  out 
the  controller  designs  according  to  P.C.(A)  only  in  order  to  get  a  quantitative  “feel”  for 
the  design  trade-offs.  The  design  and  comparative  evaluation  of  the  three  structures  is 
conducted  a  number  of  times  to  assess  the  effects  of  increasing  magnitudes  of: 

(1)  arm  tip  mass  v/u  range  ] 

>  (compare  NoFF  vs.  FSFF) 

(2)  target  frequency  v/u  range  J 

(3)  feedforward  measurement  noise}  (compare  NoFF  vs.  FFl  and  FF2  for  design 

v/u  ranges) 


3.1  Problem  Formulation 

Single  Link  Arm  Dynamics  (linearized  about  anom  =  0°): 
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where  X'a  is  the  initial  arm  state  covariance  matrix  for  parameter  condition  i  . 


Target  Dynamics: 
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where  X'Ta  is  the  initial  target  state  covariance  matrix  for  parameter  condition  i. 

It  is  assumed  that  we  are  unable  to  predict  the  phase  of  the  oscillatory  target  mo¬ 
tion  component.  Thus,  the  upper  left  quadrant  of  X'Ta  involves  diagonal  terms  only 
and  is  associated  with  rectilinear  sinusoidal  motion  of  rms  maximum  amplitude  .1 
m,  random  phase,  and  frequency  u'T.  The  bottom  right  quadrant  precisely  reflects 
the  initial  conditions  associated  with  the  ramp  component  of  the  target  motion  (i.e. 
yr,(0)  =  0;«rr(°)  =  =  02  m/sec). 


Output  Error: 


«  =  yr.  +  vr,  -  y 


Variable  parameters  for  the  problem  are: 

wT  <  wl  <  1.5  uT  (uT  =  2.84rad/sec) 

—  Mfip  —  1-5  AfiiPnom  (Mi iPnorn  =  1.25  kg) 
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3.2  Compensator  Descriptions 


(I)  NoPP  (No  Feedforward): 

T'  =  T;  =  K'  e  +  [Kt,  Kj  ]  Z}‘  +  Kltzlf  +  K6  a 


where, 


_  0  1  lf*/.l  ,  f 0 1  _»  .<  _ 

—  1.1+  ®  zi,  — 

.*/.  J  L  °2  J 


FVee  parameters  for  optimization:  Kt,  Ki,,  Klt,  K[r,  Kt,  au  a2 


(II)  FSFF  (Fall  State  Feedforward): 


t<  =  t;  +  [Cr.  C„,  C„  CVt\ 


Free  parameters  for  optimization:  Same  as  for  (I)  plus:  Cy.,  Ctr,  CVr 


(HI)  ESFF  (Estimated  State  Feedforward): 
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Each  noise  input  vt  is  assumed  to  be  exponentially  correlated  with  variance  and 
correlation  time  T  =  .005secs.  Since  this  represents  a  relatively  short  interval  compared 
with  anticipated  correlation  times  for  the  target  motion,  for  analytic  convenience  we  shall 
model1  each  j/,  as  a  white  noise  source  with  power  spectral  density  Qj/: 


E{vi{t)  Vj  (r))  =  Q//M t-r) 

Qu  ~  2T  vjj  =  .01  vjf 


(rms  intensity  i/ff  will  be  a  design  parameter) 


1  see  [6]  for  more  complete  explanation. 


3.3  Controller  Design  and  Performance  Criteria 


A  performance  criterion  is  now  defined  that  reflects  the  design  goals  discussed  in 
Section  2.0. 

P.C.(A):  Minimize  a  weighted  sum  of  mean  square  transient  and  steady-state 
errors  averaged  over  the  np  parameter  conditions 


e2-  = 


np 


9**  9'  .  9' 

;  e2  e  j(1  +  ?Ae; 


subject  to  constraints  on  the  peak  and  steady-state  control  effort: 


(*)  max  77(/)|  <  IS  N-m  (s'  =  1,  np;  t  =  0,  t /) 
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Enp  rp2< 

»=X 

np 


<  3  N-m 


The  weighting  parameters  q„  and  q  are  chosen  by  the  designer  (on  a  trial  and  error 
basis)  to  provide  a  good  balance  between  the  “optimal”  values  of  the  (averaged)  mean 
square  steady-state  and  transient  errors. 

As  a  convenient  approximation  to  this  performance  criterion,  we  define  a  quadratic  cost 
function  as  follows: 


r  ^ 

J*  =  9..  +  q*e*m  +  r„  T]'  +  r A T2’  4-  r„  T* 


A  large  value  (i.e.  500  secs)  was  chosen  for  the  finite  time  interval  f)  associated  with 
the  transient  terms  Aei!  and  AT/'  to  ensure  that  the  solution  for  minimization  of 
J*  resulted  in  stable  closed  loop  dynamics  (see  [4]  for  more  detailed  discussion).  The 
dimensionalizing  parameters  t,t  and  t,u  used  in  the  definitions  for  the  transient  terms 
(see  Section  2.3)  were  set  equal  to  10  secs  and  1  sec  respectively.  In  general,  the  actual 
peak  control  criterion  max  |T**  (<)|  is  a  rather  complicated  non-quadratic  function  of 


the  independent  controller  parameters.  As  a  convenient  quadratic  “surrogate*  for  this 
parameter,  a  weighted  sum  of  the  initial  control  excursion  squared  (T,2'^ )  and  the  mean 
square  transient  control  effort  (A7^)  is  used  in  the  above  definition  of  J‘. 

For  the  selected  error  term  weighting  parameters  q„  and  q ,  the  control  term 
weighting  parameters  r,  r0)  r„  are  varied  in  a  trial  and  error  fashion  by  the  designer 
until  the  corresponding  solution  for  minimization  of  J*  meets  the  following  constraints: 


f  A7?m  <  4  (N-m)2 
quadratic  “surrogates*  for  (*)  2 


^T2m  <  100  (N-m)2 


v...  < 


The  numerical  bound  on  initial  control  excursion  is  based  on  anticipation  that  the  optimal 
control  strategy  for  each  controller  structure  will  call  for  large  torque  early  on  in  response 
to  initial  error,  initial  error  rate,  etc.,  gradually  tapering  off  to  the  steady-state  oscillatory 
condition.  Assuming  that  the  maximum  total  control  excursion  occurs  at  t  =  0+,  we 
desire  to  limit  the  average  magnitude  of  this  excursion  to  be  less  than  or  equal  to  the 
torque  motor  peak  allowable  (15  N-m)  divided  by  a  safety-factor  of  1.5  to  account  for 
variability  of  the  initial  error  and  error  rate  magnitudes.  Squaring  this  reduced  allowable 
we  arrive  at  the  upper  bound  of  100  (N-m)2  for  7?o'^.  Similarly,  a  1.5  factor  was  applied 
to  the  torque  motor  rms  continuous  limit  of  3  N-m  to  arrive  at  a  reduced  allowable  for 
the  average  rms  continuous  (i.e.  steady-state)  torque.  Squaring  this  reduced  allowable, 
we  arrive  at  the  upper  bound  of  4  (N-m)2  for  T2jtm. 

Ideally,  the  upper  bound  on  mean  square  transient  control  effort  should  be  chosen  equal 
to  a  value  r)u  which  is  “just  small  enough*  to  ensure  that  the  optimal  control  law  will 
not  call  for  any  control  excursions  of  magnitude  greater  than  15  N-m  for  all  times  greater 
than  t  =  <o  •  In  general,  the  exact  value  of  necessary  to  achieve  this  is  not  known 
by  the  designer  a  priori  and,  in  fact,  will  depend  upon  the  controller  structure  being 
optimized.  To  avoid  additional  trial  and  error  procedures  which  would  be  required  to 
determine  rju  accurately,  a  value  of  4.0  (N-m)2  was  assumed  and  used  in  the  design  of 
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each  controller  structure.  This  choice  seemed  to  consistently  result  in  controller  designs 
that  did  not  violate  the  peak  torque  constraints  for  t  greater  than  t$  yet  allowed  for 
reasonably  fast  decay  of  transient  errors. 

It  is  likely  that  many  different  combinations  (r,  r0,  r„)  will  result  in  corresponding  control 
law  design  solutions  that  satisfy  the  above  inequality  relationships.  Thus,  to  ensure 
uniqueness  of  the  solution,  we  further  require  that  each  control  term  weighting  parameter 
be  zero  unless  the  corresponding  constraint  (i),  (ii),  or  (iii)  is  active  (i.e.  the  equality 
relation  holds). 

It  can  be  demonstrated  that  the  solution  which  meets  the  above  criteria  is  “optimal”  in 
the  sense  that  the  resulting  value  of  e'2’  is  the  minimum  value  attainable  subject  to  the 
numerical  constraints  placed  on  the  control  terms. 
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4.0  DESIGN  RESULTS  FOR  IL/1A  MODEL 


4.1  Nominal  Parameter  Case  (NoFF  vs.  FSFF) 

For  the  case  of  nominal  arm/target  dynamic  parameters  and  initial  conditions, 
SANDYl  was  used  to  synthesize  “optimal”  controller  parameters  for  the  NoFF  and  FSFF 
controller  structures  according  to  P.C.(A)  with  q  =  80  and  q„  =  50000.  Controller  pa¬ 
rameter  values,  closed  loop  eigenvalues  and  performance  data  are  summarized  in  Table 
(1).  Observe  that  the  optimized  “/,”  compensator  sub-block  contains  a  duplicate  of  the 
oscillatory  portion  of  the  nominal  target  dynamics  for  both  controllers,  thus  ensuring  zero 
steady-state  error  with  respect  to  target  oscillatory  motion  at  frequency  w  =  \/8.07 
rad/sec.  Similarly,  as  discussed  earlier,  it  is  readily  apparent  that  inclusion  of  the  1/s 
integrator  term  in  conjunction  with  the  natural  1/s  integration  from  arm  tip  velocity  to 
position  provides  a  model  of  the  ramp  portion  of  the  target  motion;  hence,  zero  steady- 
state  error  with  respect  to  the  target  ramp  motion  is  also  preserved. 

Since  the  “/,”  and  “/,”  sub-blocks  insure  zero  steady-state  error  for  the  case  of  nom¬ 
inal  target  dynamic  parameters,  the  only  effect  of  feedforward  appears  in  the  transient 
tracking  response.  As  shown  in  Table  (1),  the  percent  improvement  in  root  mean  square 
transient  tracking  error  Aem  for  the  same  control  effort  offered  by  feedforward  of  all 
target  states  is  substantial  (42%  reduction  from  NoFF  to  FSFF). 

To  provide  a  more  direct  comparison  of  the  transient  response  characteristics  of  the 
three  optimized  controllers  for  nominal  parameters,  Figs.  8  and  9  show  simulated  time 
responses  for  one  possible  set  of  initial  conditions  (i.e.  arm  tip  initially  at  rest  at  yRo ; 
target  at  max  amplitude  (.1  m)  and  beginning  “forward”  swing).  Note  the  much  lower 
undershoot  and  settling  time  obtained  with  feedforward  (Fig.  8)  for  approximately  the 
same  control  effort  (Fig.  9). 


NOMINAL  PARAMETER  CASE 


NOMINAL  PARAMETER  CASE 
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FIG.  9  CONTROL  TORQUE  TIME  HISTORIES:  NoFF  vs  FSFF  NOMINAL  PARAMETERS  CASE 

Control  torque  histories  required  to  produce  the  tracking  error  response 
of  Fig.  8.  Note  Lite  faster  transient  control  response  obtained  with 
feedforward,  resulting  directly  in  lower  transient  tracking  errors 


4.2  Effect  of  Arm  Tip  Mass  Variations  (NoFF  vs.  ESFF  at  uT  =  wTnom) 

As  discussed  previously,  inclusion  of  the  “/*”  block  in  all  three  controller  structures 
insures  zero  steady-state  error  with  respect  to  nominal  target  motion  despite  arm  pa¬ 
rameter  (e.g.  tip  mass)  variations.  Hence,  again  we  anticipate  the  effects  of  feedforward 
control  to  appear  only  in  the  transient  response  characteristics.  To  explore  the  capacity 
of  feedforward  to  provide  good  average  tracking  behavior  over  wide  ranges  of  tip  mass 
variations,  Controllers  (I)  and  (II)  were  “re-optimized”  for  increasing  values  of  a  tip  mass 
variability  range  factor  am,  defined  by: 

~  —  M\ip  <  am  Af,iPnom 

um 

For  each  integer  value  of  am(l  =  nm  =  4),  SANDYl  was  used  to  optimize 

parameters  of  both  controllers  assuming  np  =  3  corresponding  to  three  discrete  arm 
parameter  conditions: 

(0  Mi,  =  M„_,  =  ~  M,,.„  (i>  =  -3333) 

um 

(»)  Mtip  =  MliPnom  (p  =  .3333) 

(*'*'*)  Mtip  =  A =  <*m  MtiPnom  [p  =  .3333) 

Figure  II  shows  the  comparative  average  performance  over  the  three  tip  mass  con¬ 
ditions.  It  is  clear  that,  as  tip  mass  variability  range  increases,  the  FSFF  controller 
demonstrates  an  increasing  improvement  in  average  transient  tracking  performance.  For 
a  design  value  of  am  =  1.5,  full  state  feedforward  offers  a  35%  reduction  in  average  root 
mean  square  transient  error  Aem  for  the  same  control  effort. 


4.3  Effect  of  Target  Frequency  Variations  (NoFF  vs.  FSFF  at  Mtip  =  A/,,Pnom) 


If  variability  exists  in  the  target  frequency,  it  is  not  possible  to  specify  a  unique 
“/*”  control  sub-block  which  will  insure  zero  steady-state  error  with  respect  to  target 
oscillatory  motion  over  the  entire  variability  range.  Thus,  the  feedforward  compensa¬ 
tion  may  affect  steady-state  as  well  as  transient  error  behavior.  Figures  11-12  present 
performance  results  obtained  for  both  controller  structures,  each  optimized  according 
to  P.C.  (A)  with  q  =  80  and  q„  =  50000  for  increasing  values  of  a  target  frequency 
variability  factor  aUj. ,  defined  in  the  same  manner  as  am.  Once  again,  the  advantages 
of  the  FSFF  controller  are  evident,  especially  as  aUj.  becomes  large  in  which  case  both 
transient  and  steady-state  rms  errors  (averaged)  are  seen  to  be  significantly  lower  than 
for  the  optimized  NoFF  controller.  These  results  may  seem  somewhat  surprising  in  view 
of  the  sometimes-expressed  notion  that  good  feedforward  control  can  be  designed  only 
if  the  target  dynamics  are  fixed  and  well-known.  Apparently,  by  accounting  for  several 
discrete  possibilities  for  the  target  frequency  in  the  design  process  (as  was  done  here),  the 
optimization  process  produces  a  “robust”  set  of  feedforward  parameters  which  improves 
the  average  tracking  performance  over  the  target  frequency  v/u  range.  It  would  seem 
that,  when  optimizing  the  average  tracking  performance  for  any  given  range  of  target  fre¬ 
quency  v/u,  inclusion  of  independent  feedforward  parameters  should  always  be  beneficial 
since  additional  degrees-of- freedom  are  then  available  for  improving  the  performance. 

4.4  Effect  of  Noise  in  Feedforward  Measurement(s)  (NoFF  vs.  ESFF  at  aJT  —  am  —  1.5) 

Results  up  to  this  point  indicate  that  the  inclusion  of  optimally  designed  feedfor¬ 
ward  compensation  in  the  overall  target-tracking  control  scheme  does  indeed  offer  some 
significant  performance  payoffs,  especially  for  large  target  frequency  variability  ranges. 
However,  the  detrimental  effect  of  random  noise  in  the  feedforward  measurement(s),  ne¬ 
glected  up  to  now,  must  also  be  considered.  We  should  expect  that,  as  the  noise  levels  in 
the  feedforward  measurement(s)  increase  relative  to  the  feedback  measurement  noise,  the 
optimized  solution  will  call  for  lower  feedforward  gains  and  rely  more  on  the  feedback- 
only  portion  of  the  controller  structure  at  the  expense  of  tracking  accuracy.  To  explore 
this  hypothesis  in  a  quantitative  fashion,  we  now  consider  the  effect  of  increasing  levels 


of  random  (i.e.  “white”)  noise  in  the  target  measurement(s).  For  the  ESFF  controllers 
FFl  and  FF2,  optimal  parameters  are  synthesized  by  SANDY1  assuming  design  values  of 
1.5  for  both  aJr  and  am,  and  accounting  for  white  noise  sources  of  equal  power  spectral 
density  Qjj  =  2T  vjj  (see  Section  3.2)  in  each  of  the  target  state  measurements,  where 
T  is  taken  to  be  .005  secs  and  ujj  is  the  parameter  to  be  varied.  Five  discrete  parameter 
conditions  were  defined  to  bracket  the  design  ranges  for  the  variable  parameters.  These 


Cond  # 

Probability  p* 

Mtip  (kg) 

uT  (rad/sec) 

1 

.3 

1.25 

2.84 

2 

.175 

.625 

1.89 

3 

.175 

.625 

4.26 

4 

.175 

2.5 

1.89 

5 

.175 

2.5 

4.26 

For  each  controller  design,  cost  function  weighting  parameters  q„  and  q  were  chosen 
on  a  trial  and  error  basis  to  strike  a  good  balance  between  the  “optimal”  steady-state  and 
transient  error  characteristics.  Also,  in  the  optimization  process  it  was  assumed1  that 
the  target  state  estimator  had  been  running  open  loop  for  a  short  time  prior  to  t  = 
so  as  to  attenuate  the  effects  of  large  initial  estimator  errors  on  the  control  effort. 

Figures  13  and  14  show  the  resulting  optimal  transient  and  steady-state  error  per¬ 
formance  (for  approximately  the  same  control  effort)  of  the  ESFF  controllers  versus  the 
NoFF  controller  as  a  function  of  the  design  value  for  the  feedforward  measurement  white 
noise  intensity.  Since  the  NoFF  controller  does  not  use  the  feedforward  measurements, 
its  performance  is  obviously  constant  for  increasing  vjf.2  With  the  FFl  controller,  the 
transient  and  steady-state  tracking  accuracies  are  seen  to  degrade  significantly  relative 
to  that  of  NoFF  as  the  design  level  of  measurement  noise  increases.  Using  the  additional 
measurements  of  target  rate  coordinates  (FF2  controller)  appears  to  buy  considerable 

1  this  involved  recalculation  of  initial  vlaues  for  the  feedforward  compensator  states  to 
be  used  as  part  of  the  input  to  SANDYl 

2  expressed  as  a  percentage  of  the  maximum  expected  target  position  amplitude  (=  10 


improvement  in  both  transient  and  steady-state  tracking  accuracies,  especially  at  higher 
design  levels  of  measurement  noise.  At  a  design  noise  level  of  vjj  =  5%,  the  average  rms 
transient  and  steady-state  errors  with  FFl  are,  respectively,  30%  and  38%  less  than  for 
NoFF.  By  comparison,  FF2  is  seen  to  provide  more  dramatic  reductions  of  40%  in  rms 
transient  error  and  85%  in  rms  steady-state  error. 

Controller  parameters  and  average  closed  loop  performance  data  for  each  structure 
designed  for  the  five  parameter  conditions  and  vjj  =  5%  are  summarized  in  Table  (2). 
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FIG.  11  EFFECT  OF  TARGET  FREQUENCY  VARIABILITY  ON  TRANSIENT  TRACKING:  NoFF  vs  FSFF 

As  target  frequency  var iab il i ty /uncer ta inty  range  assumed  in  the  design  process 
increases,  relative  improvement  in  transient  tracking  accuracy  (for  some  control 
effort)  obtained  with  feedforward  also  increases 
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Relative  improvement  in  transient  tracking  performance  afforded  by  feedforward  of 
target  position  coordinates  only  (FFl)  degrades  rapidly  as  measurement  noise  increas 
By  eliminating  the  need  to  "differentiate"  noisy  target  position  measurements,  feed¬ 
forward  of  target  rate  measurements  (FF2)  recovers  a  significant  amount  of  performan 
at  higher  design  noise  levels 
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TABLE  2 

CLOSED  LOOP  DATA  FOR  OPTIMIZED  1L/1A  CONTROLLERS  DESIGNED 
FOR  FIVE  PARAMETER  CONDITIONS  AND  vn  =  h% 


Controller 
Parameter  Values 


(I)  NoFF 


Controller 
(II)-a  FFl 


(UI)-b  FF2 


K. 

“r.J 

K'. 

aTrj] 

bT">] 

lbT,  | 

^rr,j 

Closed  Loop  Eigenvalues  —2.04  ±  j 6.17 


[-104.2  -  10000]  [99  10000] 

[-200.8  20000]  [34.7  20000] 

|  [131.1  99.9] 

j 

|  [200.1  200] 

-5.24  ±  ;7.47  j  -.84  ±  ;6.77 


(Nominal  Parameter)  -.042  ±  33 

Condition  -24.9 

-.17  ±  ;4.26 
-.0147 

-.48  ±  j. 2 
-29.25 

Average  Performance  Data 

[ 

Aem  (m)  .019 

.014 

.011 

e.,„  (m)  |  .021 

.013 

.003 

AT*m  (N-m)2  '  3.96 

3.65 

4.48 

5.0  TWO-LINK,  TWO-ACTUATOR  MODEL 


For  this  case,  the  nominal  arm  angles  a  and  0  at  time  t  =  are  as  shown  in  Fig.  2. 
Both  torque  motors  A  and  B  are  assumed  fully  operative.  It  is  desired  to  find  control  laws 
TCa  and  Ttg  that  cause  the  arm  (with  variable  A/(ip)  to  track  effectively  a  target  under¬ 
going  elliptical  motion  at  variable  frequency  uiT  superimposed  on  the  rectilinear  cable  at¬ 
tachment  point  motion  at  constant  velocity  u„o.  To  account  for  variability/uncertainties 
in  the  eccentricity  and  orientation  of  the  target  elliptical  motion,  a  random  initial  con¬ 
dition  covariance  matrix  for  the  target  motion  was  constructed  and  used  in  the  design 
process  as  described  below.  The  total  distance  yH{t/)  over  which  the  target-tracking 
operation  will  occur  is  assumed  small  enough  to  allow  for  a  linearized  model  of  the  arm 
angle  perturbations  from  the  nominal  positions  anom  =  45°,  0nom  =  -90°. 

For  design  ranges  of  target  frequency  and  arm  tip  mass  variabilities  (i.e.  a^T  = 
am  =  1-5),  and  assuming  white  noise  sources  of  equal  power  spectral  density  ( Qff  = 
2T  where  T  is  taken  to  be  .005  secs  and  vjj  is  assumed  to  be  5%  of  the  maximum 
expected  target  amplitude  of  .1  m)  in  each  target  state  measurement,  the  NoFF  and  both 
ESFF  controller  structures  are  first  designed  and  compared  according  to  P.C.  (A).  Peak 
(continuous)  allowable  limits  of  15  N-m  (3  N-m)  were  assumed  for  each  torque  motor. 
The  NoFF  and  FFl  structures  are  then  redesigned  according  to  P.C.  (B)  to  determine 
the  torque  motor  size  required  to  match  the  tracking  accuracy  achieved  with  the  FF2 
controller. 

5.1  Problem  Formulation 

Two-Link  Arm  Dynamics  (linearized  about  alwm  ,  0„Bm): 
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where  gu  <72  depend  on  value  of  M,ip : 


i 

mL 

9\ 

92 

1 

.835 

2.15 

7.50 

2 

1.25 

1.76 

5.23 

3 

_ 

1.88 

1.38 

3.67 

_ 

Target  Dynamics: 


'V 

0 

1 

0 

0 

0 

o' 

Zr.' 

*T. 

-UJ2 

T 

0 

0 

0 

0 

0 

*T. 

9r. 

0 

0 

0 

1 

0 

0 

yT. 

Vt. 

0 

0 

-w2 

T 

0 

0 

0 

Vr. 

Vt, 

0 

0 

0 

0 

0 

1 

Vr. 

.yTr. 

0 

0 

0 

0 

0 

0 

.yTr. 

.005 

0 

0 

0 

X'T  = 


0 

0 

0 


.005  < 

T 


0 

0 


0 

.005 

0 


0 

0 

.005  uC 


0 

0 


0 

0 


0 

0 


0 

0 


0 

0 

0 

0 


0 

0 

0 

0 


0  0 
0  .0004 


Since  we  are  unable  to  predict  the  eccentricity  or  orientation  of  the  elliptical  component  of 
the  target  motion,  the  upper  left  quadrant  of  the  target  initial  covariance  matrix  *r.  was 
chosen  to  be  the  same  as  for  a  circular  trajectory  of  rms  maximum  radius  .lm,  random 
phase  (this  implies  diagonal  terms  only),  and  frequency  of  traversal  wj..  The  lower  right 
quadrant  precisely  reflects  the  initial  conditions  associated  with  the  ramp  component  of 
the  target  motion  (i.e.  Vr, (0)  =  0;vr, (0)  =  vn„  =  .02  m/sec). 


Output  Error  Components: 


» 


1 

i 


e  = 


tt  =  Xt,  —  -3535  or 

et  =  j/t,  +  yr,  —(.707  a  +  .3535/3) 


k 


l«l  =  \/el  + 


Variable  Parameters: 

—  cjt  <  uiL  <  1.5  [ujt  =  2.84  rad/sec) 

J  g  Inom  —  T  —  J«om  '  *  no*r\  '  * 

Af^„m  <  M),f  <  1.5  (M<1P_  =  1.253  kg) 


5.2  Compensator  Descriptions 


(I)  NoFF: 
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where,  (FFl)  (III)-a 


Free  Parameters  for  Optimization  (46):  Same  as  for  FFl  plus:  ;  bTt^ ;  6r,4  ; 

br,.t  i  fcr,M ; 

where, 

zi  ~  xt.  +  vi 

z*  =  *r.  +  U2 

*3  =  !/r,  + 

*4  =  +  u* 

z 5  =  yr,  +  ^5 

=  yTr  +  t't 

Each  noise  input  1/,  is  assumed  to  be  exponentially  correlated  with  rms  intensity  vj}  =  5% 
of  maximum  expected  target  amplitude  (.lm)  and  correlation  time  T  =  .005secs.  Since 
this  represents  a  relatively  short  interval  compared  with  anticipated  correlation  times  for 
the  target  motion,  for  analytic  convenience  we  shall  model  each  i/,-  as  a  white  noise  source 
with  power  spectral  density  Q //  as  follows: 

BiMtfrA*))  =  9//M*-') 

Qff  =  2 Tv),  =  Mv),  =  .25  x  1(T#  m2-sec 

5.3  Controller  Design  and  Performance  Criteria  for  2L/2A  Arm 
P.C.  (A):  For 

(K  (0|  ,  1^4  W|)  =  15  N-m  (t  =  l,np  ;  t  =  t0,tf) 
max  (TtAnm,  Ttg,J  =  3  N-m 

minimize  a  weighted  sum  of  mean  square  transient  and  steady-state  tracking  errors  av¬ 
eraged  over  the  np  parameter  conditions: 
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Enp  2*' 

«= 1  c  . 


;  e  =  g..  e‘„m  e‘„m  +  ?Ae'„  Ae^ 


P.C.  (B):  For 


A  4'  A4  c it  4  WA 


«L  =  iV„ 


where  WA  and  AT,,  are  to  be  chosen  based  on  results  using  P.C.  (A),  minimize  a  weighted 
sum  of  peak  and  steady-state  torques  averaged  over  the  np  parameter  conditions  (as  for 
the  1L/1A  case  we  use  the  first  two  terms  below  as  a  quadratic  surrogate  for  peak  torque): 


W  -  ^  T'-  ;  T?'  =  r0T'c  '  T'.  +  r  AT,*  'a  T'c  +  r„  T*  '  T! 

C  np  ’  *  °  e»m  Com  em  Cm  "  C„m  C,,„ 

For  either  performance  criterion,  define  a  quadratic  cost  function: 


t*  _  V-"P  I  n 

3  =  P  3 

J’  =  e«m  e’,cm  "b  g  ^  em  &em  +  r0  T0m  TCom  +  r  ATCm  ATm  +  r„  T«„m  Te,Jm 

When  carrying  out  the  design  according  to  P.C.  (A),  weighting  parameters  q„  and  q 
are  first  chosen  (on  a  trial  and  error  basis  for  each  structure)  to  provide  a  good  balance 
between  steady-  state  and  transient  tracking  accuracy.  For  this  choice,  r,  r0,  r„  are  then 
varied  iteratively  by  the  designer  until  the  corresponding  solution  for  minimization  of  J‘ 
yields: 

0)  ”>“*  {5J5T.  MQ  <  4  (N-m)1 
00  max  i  100  (N-m)3 

0«>  "*“  {VZ:  ThZ)  <  *  (N-“)’ 


'•  .*  .V.  .■% 
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where,  to  ensure  uniqueness  of  the  solution,  we  further  require  that  each  control  term 
weighting  parameter  be  zero  unless  the  corresponding  constraint  (i),  (ii),  or  (iii)  is  active 
(i.e.  the  equality  relation  holds). 

Conversely,  for  P.C.  (B),  we  shall  set  r,  r0)  r„  at  fixed  values  (based  on  results  for  FF2 
using  P.C.  (A))  and  vary  q„ ,  q  until  the  optimal  solution  yields: 

e«fm  e«*m  $ 

Na  set  to  corresponding  values 
of  FF2  controller  designed  for  P.C.  (A). 

A  e'm  A  em  <  Na 


6.0  DESIGN  RESULTS  FOR  2L/2A  MODEL  (aur  =  aM  =  1.5  ,  vn  =  5%) 


Five  discrete  parameter  conditions  (identical  to  those  for  the  1L/1A  case)  were  used 
to  bracket  the  design  parameter  variability  ranges.  Tables  (3)  and  (4)  summarize  average 
closed  loop  performance  data  for  the  controller  structures  optimized  according  to  P.C. 
(A).  For  specified  bounds  on  control  effort,  it  is  apparent  that  the  comparative  abilities 
of  the  three  controllers  to  minimize  steady-state  and  transient  tracking  errors  follows  the 
same  trend  as  observed  for  the  1L/1A  case.  Feedforward  of  target  position  and  velocity 
coordinates  (FF2)  is  seen  to  offer  a  44%  reduction  in  average  root  mean  square  transient 
tracking  error  Aem  and  a  large  improvement  (88%  reduction)  in  average  root  mean 
square  steady-state  error  Feedforward  of  only  target  position  coordinates  (FFl) 

provides  less  dramatic  improvements  (23%  reduction  in  Aem  ,  32%  reduction  in  e^). 

Figures  15  and  16  exemplify  robustness  characteristics  associated  with  the  optimized 
controllers.  For  the  heavy  tip  mass  (i.e.  “worst”)  case,  sensitivities  of  average  root  mean 
square  transient  and  steady-state  tracking  errors  to  actual  target  frequency  variations 
are  shown.  Note  that,  over  the  entire  design  range  of  uT  variability,  the  optimized  FF2 
controller  in  particular  provides  significantly  improved  tracking  accuracy  relative  to  the 
NoFF  controller  given  the  same  constraints  on  control  effort. 

It  is  important  at  this  point  to  analyze  the  final  designs  in  more  detail  to  check 
whether  the  original  design  goals  stated  in  Section  2.0  have  been  satisfied.  To  reiterate 
these  goals: 

(1)  error  settling  time  to  1  cm  (i.e.  10%  of  average  expected 
target  amplitude)  =  10  secs 

(2)  peak  torque  =  15  N-m 

(3)  rms  continuous  (steady-state)  torque  =  3  N-m 


I 


To  check  precisely  whether  each  of  the  goals  have  been  met  for  every  possible  combi¬ 
nation  of  arm/target  parameters  and  initial  conditions  would  require  an  infinite  number 
of  analytic  evaluations  and/or  simulation  runs.  For  the  purposes  of  this  design  study, 
we  shall  check  by  simulation  only  the  five  design  points  used  to  bracket  the  parameter 
variability  ranges  and  assume  a  “worst-case”  set  of  initial  conditions.1  The  results  of  this 
evaluation  are  contained  in  Table  (5).  It  is  seen  that  the  FF2  controller  is  by  far  the 
most  consistent  in  achieving  the  10  second  settling  time  goal  except  at  v/u  parameter 
condition  3,  at  which  12.4  seconds  is  required  for  settling  to  the  10%  goal.  This  condi¬ 
tion  corresponds  to  the  case  where  M(,p  and  uiT  are  50%  higher  than  their  respective 
nominal  values,  and  would  intuitively  seem  to  be  the  most  difficult  condition  for  which 
to  provide  good  control.  Neither  FFl  nor  NoFF  achieved  the  10%  goal  before  10  seconds 
at  any  of  the  v/u  parameter  conditions  checked.  In  fact,  with  the  exception  of  the  FFl 
controller  at  the  nominal  parameter  condition  (1),  the  tracking  errors  associated  with 
FFl  and  NoFF  are  observed  never  to  settle  below  10%.  In  terms  of  peak  control  torque 
encountered,  all  three  controllers  are  seen  to  meet  the  design  constraint  of  15  N-m,  with 
TCg  of  the  NoFF  controller  coming  the  closest  to  violation  with  a  14.7  N-m  excursion 
which  occured  at  t  —  0+  in  reponse  to  the  assumed  worst  case  initial  error  of  .1265  m. 
Rms  continuous  torques  are  also  seen  to  lie  safely  below  the  allowable  limit  of  3  N-m. 

Discrete-time  linear  simulations  for  the  three  controller  structures  optimized  to 
P.C.  (A),  including  the  effects  of  feedforward  measurement  noise,  are  shown  in  Figs. 
17-20.  The  first  two  figures  present  comparative  time  histories  for  the  position  error 
magnitude  and  the  two  control  torques  TC/i  and  Zs  for  the  case  of  nominal  arm  tip 
mass/target  frequency  and  worst-case  initial  conditions.  Feedforward  measurement  noise 
roughly  equivalent  to  that  assumed  in  the  design  {yjj  =  5%)  was  simulated  using  a 
random  number  generating  routine.  The  FF2  controller  clearly  meets  the  design  goals 
of  Section  2.0  at  this  particular  condition:  the  position  error  magnitude  is  seen  to  settle 
to  the  10%  goal  after  only  3  secs  compared  with  the  required  settling  time  of  10  secs. 
By  contrast,  the  FFl  controller  is  seen  to  require  a  16  sec  settling  time  while  the  NoFF 
controller  never  settles  below  10%.  The  control  torque  histories  for  this  condition  are 
quite  similar  for  all  controllers,  as  expected  (due  to  identical  control  torque  constraints 

1  i.e.  the  case  where  x0  =  [Oj  and  xTg  =  (.1265,  0,  0,  -.1795,  0,  .02)'  which  corresponds 
to  target  elliptical  motion  with  average  amplitude  =  .1  m  and  eccentricity  =  .866. 


assumed  in  the  design  process).  The  peak  torque  constraint  of  ±  15  N-m  is  met  by  all 
three  controllers  at  this  condition.  Note  the  greater  noise  response  associated  with  the 
control  torque  histories  of  the  FFl  controller  using  noisy  target  position  measurements 
only.  Figures  19-20  show  comparative  time  histories  for  the  (worst)  case  parameter 
condition  where  the  arm  tip  mass  and  target  frequency  are  each  50%  higher  than  their 
nominal  values.  In  this  case,  the  position  error  magnitude  for  the  FF2  controller  is  seen 
to  require  slightly  greater  than  4  secs  to  settle  below  the  10%  goal,  while  the  NoFF 
controller  and  the  FFl  controller  never  settle  below  10%  for  the  same  constraints  on 
control  effort. 

The  above  results  indicate  that  the  FF2  controller  requiring  sensors  for  both  target 
position  and  rate  coordinates  should  be  implemented  in  order  to  meet  design  goals  for 
tracking  accuracy  without  violating  the  given  control  constraints.  It  is  of  interest  to 
know  how  much  larger  the  torque  motor  limits  would  have  to  be  for  the  NoFF  and  FFl 
controllers  (requiring  fewer  sensors)  to  match  the  tracking  accuracy  achieved  with  FF2. 
Accordingly,  both  the  NoFF  and  the  FFl  structures  were  re-optimized  using  P.C.  (B) 
of  Section  5.0,  with  numerical  bounds  NA  and  N„  on  the  average  root  mean  square 
transient  and  steady-state  errors  assumed  to  be  the  corresponding  values  associated  with 
the  FF2  controller  optimized  using  P.C.(A)  (which  appears  to  very  nearly  satisfy  all  design 
goals).  Results  of  this  re-optimization  indicated  that  the  torque  motor  peak  limits  would 
have  to  be  approximately  (40  N-m)  and  (20  N-m)  to  accomodate  error  requirements  with 
NoFF  and  FFl,  respectively.  Thus,  if  torque  motor  size  were  a  variable  in  the  overall 
system  design  process,  the  designer  would  have  to  weigh  the  costs  of  obtaining  larger 
torque  motors  and  using  fewer  sensors  against  using  smaller  torque  motors  and  more 


sensors. 


TABLE  3 

CLOSED  LOOP  CONTROLLER  PARAMETERS  FOR  OPTIMIZED  2L/2A  CONTROLLERS 
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TABLE  4 

AVERAGE  PERFORMANCE  DATA  FOR  OPTIMZIED  2L/2A  CONTROLLERS 
DESIGNED  FOR  FIVE  PARAMETER  CONDITIONS  AND  vn  =  5% 
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7.0  CONCLUSIONS 


This  design  study  has  demonstrated  that  the  addition  of  feedforward  compensation 
to  a  basic  feedback-only  (NoFF)  controller  structure  for  a  target-tracking  mechanical  arm 
can  provide  a  marked  improvement  in  the  arm’s  ability  to  track  an  oscillating  target  for 
a  given  level  of  control  effort  despite  variations  or  uncertainties  in  the  dynamic  param¬ 
eters  of  both  arm  and  target.  In  particular,  a  single-link,  single  actuator  version  of  the 
tracking  design  problem  was  used  to  show  that,  in  the  absence  of  feedforward  measure¬ 
ment  noise,  inclusion  of  either  full  state  feedforward  (FSFF)  or  its  near  equivalent  using 
target  position  measurement  together  with  an  approximate  diferentiation  network  to  ob¬ 
tain  target  rate  produced  large  reductions  in  average  transient  and  steady-state  tracking 
errors  relative  to  the  NoFF  structure  given  the  same  constraints  on  control  effort.  Fur¬ 
thermore,  this  relative  improvement  is  seen  to  increase  as  the  target  frequency  and  arm 
tip  mass  variability  ranges  increase  (see  Figs.  11-12).  As  noise  is  introduced  into  the 
feedforward  measurements,  however,  it  was  seen  (Figs.  13  and  14)  that  the  use  of  target 
position  coordinate  measurements  only  (FFl)  resulted  in  a  tracking  performance  which 
degraded  significantly  for  increasing  levels  of  nearly  “white”  sensor  noise.  By  contrast, 
with  feedforward  using  both  target  position  and  rate  coordinated  measurements  (FF2), 
a  considerable  performance  improvement  was  achieved  even  at  fairly  high  intensities  of 
white  noise  in  all  feedforward  measurements. 

The  design  comparison  conducted  for  the  two-link,  two-actuator  model  of  the  arm 
confirmed  the  trends  observed  for  the  single-link,  single  actuator  case  at  design  values 
for  arm  tip  mass/target  frequency  variability  range  factors  and  feedforward  measurement 
noise  intensity.  The  FF2  controller  was  shown  to  provide  a  (44%)  reduction  in  average 
root  mean  square  transient  tracking  error  and  an  (88%)  reduction  in  average  root  mean 
square  steady-state  error  relative  to  the  NoFF  structure  for  the  same  constraints  on 
control  effort  (Table  5).  Furthermore,  this  structure  was  the  only  one  to  meet  all  design 
goals  discussed  in  Section  2.0.  It  was  also  determined  that  a  (33%)  increase  in  the  peak 
allowable  torque  would  be  required  for  the  FFl  structure  to  achieve  the  same 


average  tracking  accuracy  as  the  FF2  structure,  while  a  (167%)  increase  would  be  required 
for  the  NoFF  structure. 

This  report  has  attempted  to  predict,  in  consistent  and  quantitative  fashion,  the 
improvements  attainable  by  including  feedforward  in  the  overall  target-tracking  control 
scheme  for  a  mechanical  arm.  Final  decision  on  the  choice  of  the  overall  feedforward/feed- 
back  controller  structure  should  weigh  the  results  predicted  against  the  complexities  and 
costs  associated  with  implementation  of  the  structure. 
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